Cream of the Crop 26/Cream of the Crop 26.iso/os2/plnk081.zip/pilot-link.0.8.1/pi-port.c

C/C++ Source or Header | 1997-06-14 | 5KB | 215 lines

/* pi-port.c:  Serial server
 *
 * Copyright (c) 1997, Kenneth Albanowski
 *
 * This is free software, licensed under the GNU Public License V2.
 * See the file COPYING for details.
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include "pi-source.h"
#include "pi-socket.h"
#include "pi-dlp.h"
#include "pi-serial.h"
#include "pi-slp.h"
#include <signal.h>

#include <sys/types.h>
#include <sys/socket.h>
#include <netinet/in.h>
#include <arpa/inet.h>
#include <netdb.h>

void sigint(int num)
{
  *((char*)0)=0;
}

void do_read(struct pi_socket * ps, int type, char * buffer, int length)
{
  fprintf(stderr, "A %d byte packet of type %d has been received from the network\n", length, type);
  dumpdata(buffer, length);
  if (type == 0 ) {
    struct pi_skb * nskb;
    nskb = (struct pi_skb *)malloc(sizeof(struct pi_skb));

    nskb->source = buffer[0];
    nskb->dest = buffer[1];
    nskb->type = buffer[2];
    nskb->id = buffer[3];

    memcpy(&nskb->data[10], buffer+4, length-4);
    slp_tx(ps, nskb, length-4);

  } else if (type == 1 ) {

    ps->rate = get_long(buffer);
    pi_serial_flush(ps);
    ps->serial_changebaud(ps);
  }
}

int main(int argc, char *argv[])
{
  struct pi_sockaddr addr;
  int sd;
  struct pi_socket * ps;
  int ret;
  struct sockaddr_in serv_addr;
  int serverfd, fd;
  char * buffer;
  char * slpbuffer;
  char * device = argv[1];
  int port = 4386;

  extern char* optarg;
  extern int optind;

  if (argc<2) {
      puts("Usage: pi-port serialdevice");
      exit(0);
  }

  signal(SIGINT, sigint);

  buffer = malloc(0xFFFF+128);
  slpbuffer = malloc(0xFFFF+128);

  if ((serverfd = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
    perror("Unable to obtain socket");
    goto end;
  }

  memset((char*)&serv_addr, 0, sizeof(serv_addr));
  serv_addr.sin_family = AF_INET;
  serv_addr.sin_addr.s_addr = htonl(INADDR_ANY);
  serv_addr.sin_port = htons(port);

  if (bind(serverfd, (struct sockaddr*)&serv_addr, sizeof(serv_addr))<0) {
    perror("Unable to bind local address");
    goto end;
  }

  listen(serverfd, 5);

  if (!(sd = pi_socket(PI_AF_SLP, PI_SOCK_RAW, PI_PF_SLP))) {
    perror("pi_socket");
    exit(1);
  }

  addr.pi_family = PI_AF_SLP;
  strcpy(addr.pi_device,device);

  ret = pi_bind(sd, (struct sockaddr*)&addr, sizeof(addr));
  if(ret == -1) {
    perror("pi_bind");
    exit(1);
  }

  ps = find_pi_socket(sd);
  ps->rate = 9600;
  ps->serial_changebaud(ps);

  for (;;) {
    int l;
    int max;
    fd_set rset, wset, eset, oset;
    struct sockaddr_in conn_addr;
    int connlen = sizeof(conn_addr);
    int sent;

    fd = accept(serverfd, (struct sockaddr*)&conn_addr, &connlen);

    if (fd < 0) {
      perror("Server: accept error");
      goto end;
    }

    FD_ZERO(&oset);
    FD_SET(fd, &oset);
    FD_SET(sd, &oset);

    sent = 0;
    l = 0;

    max = fd;
    if (sd>max)
      max = sd;
    max++;

    for(;;) {
      rset = wset = eset = oset;
      select(max, &rset, &wset, &eset, 0);

      if (FD_ISSET(fd, &rset)) {
        int r = read(fd, buffer+l, 0xFFFF-l);

        if (r<0)
          break;

        if (r==0)
          goto skip;

        fprintf(stderr, "Read %d bytes from network at block+%d:\n", r, l);
        dumpdata(buffer+l, r);

        l += r;
        if (l>=4) {
          int blen;
          while(l >= 4 && (l >= (blen = get_short(buffer+2))+4 )) {
            fprintf(stderr, "l = %d, blen = %d\n", l, blen);
            do_read(ps, get_short(buffer),buffer+4,blen);
            l = l-blen-4;
            if (l>blen) {
              memmove(buffer,buffer+4+blen,l);
            }
            fprintf(stderr, "Buffer now is:\n");
            dumpdata(buffer, l);
          }
        }
        skip:
        ;
      }
      if (FD_ISSET(sd, &rset)) {
        ps->serial_read(ps, 1);
        if (ps->rxq) {
          fprintf(stderr, "A %d byte packet has been received from the serial port\n", ps->rxq->len);
        }
      }
      if (FD_ISSET(fd, &wset) && ps->rxq) {
        int w = write(fd, ps->rxq->data+sent, ps->rxq->len-sent);

        if (w<0)
          break;

        sent += w;
        if (w >= ps->rxq->len) {
          struct pi_skb * skb = ps->rxq;
          ps->rxq = ps->rxq->next;

          fprintf(stderr, "A %d byte packet has been sent over the network\n", skb->len);
          free(skb);
          sent = 0;
        }

      }
      if (FD_ISSET(sd, &wset) && ps->txq) {
        fprintf(stderr, "A %d byte packet is being sent to the serial port\n", ps->txq->len);
        ps->serial_write(ps);
      }
      if (FD_ISSET(fd, &eset)) {
          break;
      }
      if (FD_ISSET(sd, &eset)) {
          break;
      }
    }
  }
end:
  exit(0);
}